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(54) ATTITUDE ANGLE DETECTING METHOD FOR ANGULAR VELOCITY SENSOR TYPE ATTITUDE ANGLE DETECTOR 
(57)Abstract: 

PURPOSE: To enhance a detecting accuracy of an angular velocity sensor while 
preventing an increase in cost. 

CONSTITUTION: Before an attitude angle detector having angular velocity sensors 12, 
14, 16 mounted at X- Y-and Z-axes is placed at a body 1, an erroneous angular 
velocity is detected, and stored in a non-volatile memory 24. The erroneous velocity is 

obtained from an output vale of angular velocity sensors of two shafts perpendicularly ****ew_ ^ 

crossed at a detecting shaft by rotating it around the detection shaft by a rotary table. 1 ' > iWMWg> , 
After the angle detector is placed at the body, the erroneous value is subtracted from ^ Noggg 
the output value of the sensors of the two shafts when it is rotated around the ^ " | \ a 

detection shaft. In order to correct the error of the angular velocity generated from the 
fact that axes of the three angular velocity sensors are not perpendicularly crossed, it 
can be electrically executed, and its coat can be reduced by enhancing a mechanical 
accuracy. 
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14, 16, Aniifi-lrvf-l 1, 13, 1 7*3«tt/ittHK 
^tfrflMr • 1 5 (4, *Jlii«Ti4l2] 4 {r^-f^— * 7" 
<ay9 2 0^-e^-e'nflZ#{tbil, r.co-<— *y a ? 
2 0 Sr^Ltitl «cS:^@5feS^TV-'5. &*3, 1214 

[0 02 1] ^7'ny^2 0li, X-Y^FffiiW 20 
(c:^ £ axfcfiSE 2 0 a £ , X-Z¥Si ¥frl:» $ 
Ktimk 2 0 b t , Y-ZWt ¥frt-^fiS;$^/dftiJffi 
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fflffl^/iotv^, -tUT, rwHlirss-r— ^vU2 7^ 

7"n 7^20 ©*U»z*«»iS*i*!«riSlR|-*-* J: 5 (-1" 
5o i"**>*>, IH4i^b7t^St?^— ^^ff? 2 0 
^mifiKT 1 — 7* A- 2 7!r|l|)tf fio -<-^- 
7'n 7^2 7 KttEl 5 t^/Tci-J; 5l:ayhD-78roc 
P U 2 3 *3 J; J t y 2 4 ^&ft3i!«-fe Vf- £ 

*tT* < o *tT, #ft jfift-fe yf 12, 1 



(5) #0PF7 - 2 3 4 1 2 6 

4 , 16 & A / D 2 8«rLtCPU2 3 frssst 

[0 0 3 4] r GO J; 5 {-III'liiT"-— 2 7 ic-s— 

XT* d ?7 2 0 arllxtttt'/ifL III 6 lc:^i-<t 5 HHE 
=f—^>v 2 7 «r»Jh**fc*WB8T? 1 0S»IB/S»t#A3a* 

MftaiScoXO, coYO, coZOi: LTCPU2 3<D?FI2|^:<7? 
/0 ^-E-U {^nElt^-ti-fio WCPU2 3(rgE'|&£ 

•h. cpu23 ■km^-t^ y=7 u<om^, 
m-r fi <t o k y * y 2 4 gait $ -n- a r n ^ 9 

[0 0 3 5] ^-co^, m^r—-f/V2 7 ^to/ttoycHI 
itemSrt.o-CIH^*-fr, 0^-7*^2 7 as— SlHlilfe* 
-em {'#ft j4J$-fc vy- lUotft 5SJt Sr^ 

20 ^ft^4rft3S*-trvy-<73||ftjgJtcoX, a>Y, mZ t LT 

cpu 2 3co^--&y }rfs«^-&5 0 rco j; 5 fr^ftjgfi 
coX, coY, coZ SrttWUfclft, milEx— ^A-2 7 SrfltJh 

[0 0 3 6] ?*V>-C % #ft5Sft-fe>-y-c0^ftjgftcoX, 
coY, coZ «=>&{DffiAXfta>XO, coYO, a>Z0£«L.§l^ 
Tftjg^tliP^A coX, AcoY, AcoZ S^ft-Wl.** 

•5„ -tb-c, xttmycoftjg^-irv-y-i 2wftjiB^tl7jn 

^ A coX *3±tFYttm '9 ©ft3Si$-1r V-y- 1 4 OftJSfttt 
A co Y 'He , Z Wim i? ©ft 34 Sir v-fr 1 6 "T-coft 34iJ 
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ftiSiScoXO, coYO, coZ0Sr^iiJ$-&, b^S^^StTSBlRl 
^ «tr|l|i|to^— y/U2 7S:mife$-li-Clfeft3aacoX, coY, 
coZ fir*0iS-*6. Ai*ft*Wl*ft»4Z«ria5©»afe«r 
•Mthll-S i # i PWRlci-S. 

[0 0 3 8] -e^fJL |gft3litcoX, ojY, ojZ a-^^jjffl 
ftJSfficoXO, coYO, coZO&&b5l^tft3ia^JP^->A co 
X, AcoY, AcoZ &*to, ^P>{C, Y!|i|lim9ft5S;j£ir>- 
■y- 1 4 Oft 3ffi*±iin^-> A co Ydo «t O* Z ttm 9 ft 3Si$-lr V 
•y- 1 6 e^3SS£iiAn^-> A co Z& XWlEI 9 ft iSft-ir Vf" 1 

2Wftii^lf*P^A coX xt^m%Lxwx-MM&^ 
■it 9 WIRSftiS^KYX, KZXSr** 5 0 n « «t 5 
50 ftil^KYX, KZXSr**fc^, CPU2 3lim^» 
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m± * * y 2 4 RBfs * s o 

[0 0 3 9] * it x Z Hi , X Ml [II 5 coiKSIft m& & * » 
ifc^U ^7s7 l< P yt? 2 0(7)Yi|i|l|^jE^|^J^if|^|^ 

5± 5tebTStfBJ£1"<5 0 tit, 

JiScoXO, coYO, toZOSrlfeW**, b^S^KHlMET 1 -- 

TOu 2 7 frgflg & HtTlSft 3SS co X, to Y, to Z Srtft ttl $ 

[0 04 0] *ft3tSo>X, cuY, *=»6tDJB 

ftjfilttoXO, coYO, fl)ZOSrS6L3l^-C^i3i«*iAP^Aa) 
X, AcuY, AcoZ Sfefc, X«iEI9*a«-fe> 

f-1 2 0>ftii#iMn#A ojXtsitfZttEIO^ijftS^V 
f- 1 6 0>ft»*ifin# A aiZSrYttHI 9 ftiSaCiri'* 1 
MDftMBBWttfr* coY T?-tnm»bTJMtAi**a 
fc5<0»S£fta*KXY, KZYSr*ft« 0 -<OJ;5Kfl&S 
ft3SftKXY, KZYSr#»fc«, C P U 2 3 tt-t*i,«:^ff 
«tty-=E-!J 2 4(-fE«^-tt^)o 

[0041] rco«fc 51-x, y, zianao^*^^ 20 

[0 0 4 2] ±»Lfc»K*ffl3»KJ:oTI«eAa* 
^fElg^^c^vhn-^sSrffiiffli-^i:, EI 7 ir^-T 

J»B<0ft*#o>X tt, YttBOAiSA-feviM 4, Z$di 
HOAiSfiMr^iM 6#ft3I*a>Y, wZSrtti* bTV^3 
i:#^f^a)YxKYX(Dffit, coZxKZXcoffii^-^n-m 50 
*bg|*MxTJt<Pfta!#a)X' t3E*.bti/4 n fcK* 
5c Sfc, WJII|fcL-CY«llH9*JS*irviM 4iao 

tl2, Z MSI 9 ft 3i« >^ 1 6 £Sft ^ co X, co Z £r 
ttW bT^3 t^^^caXxKXYcofCi:, a>ZxKZY<7>fiS 

5cti:4So S&fc, ZttiHI9ft3i^lrv^l 6tnJ; 
o-ClfttHSixfclSBR^ft3a*a)Z fc, xM0Oftit*-fe 
viJ- 1 2 , YtiliHI 5 ftiS*-fe^ 1 4 ds^jSJEwX, coY 
SrW*LTV^Si:#l2:ttajXXKXZ(Otti:, a)YXKYZ(7) 40 

[0 0 4 3] LWi^t, Sfg^ftifi^ViM 2, 1 
4, 16 C0#^>^*{* 12a, 14 a, 16a <Z>tfetH 

Mfl***:E v as b * t i k jbh b -c ^ c s ft 3S*o 

IS««:««»fc*BjEi-4^4:*s-e#6 0 d^fcft, &ft 
jl^-br - 12, 14, 16 coir vlMscfls: 12a, 14 
a , 16at^l2b, 14b, 16 b KjJRft*** 
t ot*ttltfc 9 , #ft 3SS£-fc ^ 12, 14, l 
6 &s<—^ y* p 5/ * 2 0 fci**ftSM-te«ife» b/t D i~5 50 



4*BB¥7 -2 3 4 1 2 6 

[ 0 0 4 4 ] ft*3, *iafc«n?ttl»S&ft3fiA4: It X, 
Y, zM^3Mlll»^S*b-C*«)5fi?IIS:*bfc3iS, ZM 
El «9 <so«^ft ffl*co*S:*«)T XMHI 9 ft 3fii£i? ^ 1 
2 , YMH D ft 3M£i? 1 4 astfctH bfcft 3ift co X, 
coY^rMlEb^^-r^i. — y 3 7^<Z>S5»^fcfrtftt; 
«Wi(B»*fc*JW-* - 5r.t*s-e#5o Sfc, ft 31*^^ 
i>- 12, 14, 16 1 id Hx# it 5 fc. ^ ct)-<— x y* 

u y $ 2 0 t LXlt, fcmMMX*7sk L/c ± 5 irffijR**- 
3*ift^3(6libfcJ:5ft1»5fil-RR3t*^5 fcot»lift 

[0 0 4 5] ^bid, *SHftffl|-ett, 
ft<ftffi*ftfe*A^y ^^^^^ft^ffi^ffii-ii/H b 
fc 0fl * b fc , ± fc 4 ^ l± tK f jfefi 1 1" 5 ftbtfo (o m 

[0 0 4 6] 

S-T 5 3 M«Jcft3B*-fe^*«»#*t bttfcSaWHfcffl 
MoftiSaflr^tOtBiJttSrlRajllCt bT^W5§14^ ^& 

y ^isits^, r o^ft ^ta^ff (^jtte <* n 

fc« f4fltJiSmi±JiWlEl 0 Km 5 <t * KflufS 2 tt^ft 3*Sir 

ffloft**ir^ottj|*dSEv^tESb*v^r t teiBH 
bT*CSft3B*0»liE«:«*l»te*|jEi" 5 ^ t ^t:^ 

So 

[0 0 4 7] bfc*So"C, ftiSSir^-CQ^frSr^-— ^ 

»ft*itiaaiiKjK»*teffiiii«:* bfc «9 -*-a*5*3ss* < 

H 6 ^ K#ooK«f*fcft 3i* fetft ttl^ 5 r. £ t? # 

[El l ] ^itti^tel^ J: o tgi^ ^ 

[III 2 ] *JBWK«SS5»ft*ttl**»J: J: o Tg?^ft & 

[ei s ] iiiiife^-^u±^^m^fw^m 

fz.tb<ny*u y?m\-eh&o 

m 6 ] iaey-y^±wiiRj6iiB»ffl 
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CPU 
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Kyx 



.AU/X 



If, 



0 ^uJK 



ft^WX 
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0 A£i/Y 



K ^WZ 



0 Zlo/Y 
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WY 
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0 AU>Z 



UJZ 



23 
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